Построение и исследование динамической модели портального манипулятора 


Аннотация 

Данная работа посвящена построению и исследованию динамической модели 
портального манипулятора, описывающей переходные процессы в манипуляторе с 
шаговым приводом в момент его позиционирования. При построении были использованы 
экспериментально полученные параметры, благодаря чему удалось получить достаточно 
простую и адекватную модель. 

При составлении подобных моделей у разработчика возникает стремление как можно 
более полно отразить свойства и характеристики объекта, что приводит к чрезмерному 
росту сложности модели, в результате чего снижается ее практическая полезность. 
Поэтому в данной работе особое внимание уделено разумному упрощению модели, а 
также возможности ее практического использования. 

В ходе исследования полученной модели решена задача выбора оптимальной скорости 
перемещения рабочего органа, определена степень влияния точности позиционирования 
на быстродействие манипулятора. 

Полученные результаты исследований могут быть использованы при проектировании 
новых и эксплуатации имеющихся моделей манипуляторов для определения 
рациональных значений динамических параметров. 


Введение 

Для решения задачи выбора оптимальной скорости перемещения звеньев манипулятора 
с шаговым двигателем, с целью увеличения его быстродействия, необходимо учитывать 
переходные процессы возникающие при позиционировании рабочих органов. Переходные 
процессы в виде затухающих механических колебаний возникают под действием 
инерционных нагрузок и приводят к увеличению времени позиционирования при 
выполнении переходов технологического процесса, например, при сборке, сверлении, 
контроле и др. Для планирования траектории необходимо знать время затухания 
колебаний до значения допустимой погрешности позиционирования, при котором 
рабочий орган манипулятора может продолжать движение. С целью определения 
времени такого переходного процесса создана модель манипулятора портального типа с 
консольной подвижной частью. 


Моделирование динамики манипулятора 

Методы построения динамической модели манипулятора 

Динамическая модель манипулятора может быть построена на основе использования 
известных законов ньютоновской или лагранжевой механики. Результатом применения 
этих законов являются уравнения, связывающие действующие в сочленениях силы и 
моменты с кинематическими характеристиками и параметрами движения звеньев. Таким 
образом, уравнения динамики движения реального манипулятора могут быть получены 
традиционными методами Лагранжа - Эйлера или Ньютона - Эйлера. С помощью этих 
двух методов получен ряд различных форм уравнения движения, эквивалентных в том 
смысле, что они описывают динамику движения одной и той же физической системы. 
Вывод уравнений динамики движения манипулятора методом Лагранжа - Эйлера 
отличается простотой и единством подхода. В рамках предположения о том, что звенья 
представляют собой твердые тела, этот подход приводит в общем случае к системе 
нелинейных дифференциальных уравнений второго порядка. Уравнения Лагранжа - 
Эйлера обеспечивают строгое описание динамики состояния манипулятора и могут быть 
использованы для разработки усовершенствованных законов управления в пространстве 
присоединенных переменных. В меньшей степени они используются для решения прямой 
и обратной задач динамики. Прямая задача состоит в том, чтобы по заданным силам и 


моментам определить обобщенные ускорения, интегрирование которых позволяет 
получить значения обобщенных координат и скоростей. Обратная задача динамики 
заключается в том, чтобы по заданным обобщенным координатам, скоростям и 
ускорениям определить действующие в сочленениях манипулятора силы и моменты. 

С целью получения более эффективных с вычислительной точки зрения алгоритмов 
можно использовать уравнения Ньютона - Эйлера. Вывод уравнений движения 
манипулятора методом Ньютона - Эйлера прост по содержанию, но весьма трудоемок. 
Результатом является система прямых и обратных рекуррентных уравнений, 
последовательно применяемых к звеньям манипулятора. С помощью прямых уравнений 
последовательно от основания к схвату вычисляются кинематические характеристики 
движения звеньев, такие, как линейные и угловые скорости и ускорения, линейные 
ускорения центров масс звеньев. Обратные уравнения позволяют последовательно от 
схвата к основанию вычислить силы и моменты, действующие на каждое из звеньев. 
Наиболее важный результат такого подхода состоит в том, что время, необходимое для 
вычисления обобщенных сил и моментов прямо и пропорционально числу сочленений, но 
не зависит от реализующейся в процессе движения конфигурации манипулятора. Это 
позволяет реализовывать простые законы управления манипулятором в реальном 
времени. 

Низкая вычислительная эффективность уравнений Лагранжа - Эйлера обусловлена в 
основном тем, что для описания кинематической цепи используются матрицы 
преобразования однородных координат. Уравнения Ньютона - Эйлера обладают большей 
вычислительной эффективностью, что связано с их рекуррентной природой. Однако 
такие рекуррентные уравнения не обладают “аналитичностью”, столь полезной при 
синтезе управления в пространстве состояний. Для синтеза законов управления 
желательно иметь в распоряжении замкнутую систему дифференциальных уравнений, 
точно описывающих динамику движения манипулятора. 

В связи с тем что для построения модели динамики переходных процессов и дальнейшего 
анализа полученных уравнений необходима аналитическая форма, решено использовать 
для получения уравнений динамики метод Лагранжа - Эйлера. 


Уравнения динамики манипулятора 
Уравнения Лагранжа второго рода для голономной системы с п степенями свободы, 


которым отвечают обобщенные координаты Ч (/ = 1,2,...,п), имеют вид 
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а 29, 29, (/ = 1,2,...,п), 


где І, = Т- П - функция Лагранжа, разности кинетической Т и потенциальной П 


энергий системы; “М - обобщенные силы управляющих приводов, приведенные к ой 
обобщенной координате: они имеют размерность моментов, если м угол поворота, или 


сил, если 4 - линейное перемещениє. 


и ОГ]оа, =0 
С учетом того, что І-Т- П и п 9 ‚ перепишем уравнение (1.1) в виде 
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В последних равенствах через 3 обозначены внешние обобщенные силы, вызванные 
весом звеньев и груза, удерживаемого в захватном устройстве. При наличии внешнего 


воздействия - силы · в, приложенной к захватному устройству, в правую часть равенства 


для Ј надо добавить член Ше характеризующий это воздействие: 
= +0, +0 (1.3) 


Используем выражение (1.2) для вывода уравнений динамики манипулятора. 
Рассматривая исполнительный механизм манипулятора как систему из п твердых тел, 
запишем его кинетическую энергию Тв виде суммы кинетических энергий звеньев: 


т=У Т (1.4) 
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МЕ 
В свою очередь величину ! определим по формуле [3] 


Т = т% + т(У,; х) т от 8; (1.5) 
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Мо; С А е; Г. 
где Иа масса звена і 07 - скорость некоторой точки звена 1, принятой за полюс; М 
- вектор радиус центра инерции звена в системе осей с ним связанных, начало которой 
о Ө, О п 
совпадает с полюсом 1; 1 - тензор инерции звена в точке 1; 1 
скорости звена в принятой системе координат. 


- вектор угловой 


20 


Хо 


Рис. 1.1. Связанные системы координат с 
началом в центре кинематической пары 
0о,0.,0,0 
(О х у,2,) и в центре инерции о х, У, 2, ) 
Р 14531 


Выражение (1.5) принимает наиболее простой вид, если за полюс звена принять его 


ГГ: 
центр инерции; величина 7 будет равна нулю и выражение (1.5) упростится: 


Т = т% +0 Ө, о; (1.6) 


Кроме того, в большинстве случаев звенья манипулятора представляют собой твердые 
тела, обладающие симметрией относительно трех ортогональных осей, проведенных 
через центр инерции. Напомнив правило разметки осей систем координат, связанных со 


й Ох у 2, 
звеньями, в соответствии с которым одна из осеи системы 1х У; 1 совпадает с осью 


9..9 


Г), а две другие образуют с ней правую триаду, получим при 


звена (вектором 


помещении точки і в центр инерции і (см. рис. 1.1) оси полученной системы 


ху становятся главными осями инерции и тензор вектора в точке ї имеет ВИД 
диагональной матрицы 


У 50 
Фо = 0 Л, 0 (1.7) 
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моменты инерции относительно осей в которой определяются выражениями 


1.=[ +2) ат 
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и для звеньев АННОЙ конфигурации являются известными константами. При 


отсутствии осевых симметрий тензор инерции звена в точке 1 характеризуется 


матрицей 

ле в ал 
Оо = - 5 Ј, Л (1.9) 
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центробежные моменты в которой определяются выражениями 
У яя =Ј, = Ї рат 
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и также являются известными константами. 


Определим вектор скорости центра инерции звена 1 через проекции на оси связанной с 
ним системы координат как 
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И, и, Ид) (1.11) 
или через проекции на оси неподвижной системы осей в виде 
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По аналогии с  Щ введем вектор угловои скорости звена 


26 т 
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и запишем равенство (1.6) в развернутой форме для случая, когда звенья манипулятора 
обладают симметрией относительно главных осей инерции. Для этого подставим 
0 


выражения ` 0), Ух, 07: из (1.7), (1.11), (1.13) в (1.6) и получим 
= 2 2 2 
Т =05и и. + М 5 №.) + 087,2 + тут (1.14) 
При использовании вектора скорости центра инерции в форме (1.14) выражение 
РЕК 2 2 2 
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с учетом которого равенство (1.4) принимаєт вид 
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Построение динамической модели переходных процессов манипулятора МРЛ- 
901п 
Модель переходных процессов в манипуляторе МРЛ-901П 


Рис. 2.1. Физическая модель портального манипулятора: 

9, 92, 93 - смещение звеньев манипулятора вследствие деформации, 
ов – угол изгиба основания консоли вследствие деформации; 

т — сосредоточенная масса, 

і - плечо приложения сосредоточенной массы. 


Модель  портального манипулятора МРЛ-901П представлена на рис. 2.1. 
Деформирующимися элементами в манипуляторе являются: зубчатый ремень, 
обозначенный пружиной; консольная часть, на которой имеется сосредоточенная масса 


т. Деформация поперечной консоли обозначена на схеме углом с Исходньми данньми 
для расчета такой модели будут: значение подвижной массы 11, плечо приложения этой 
массы [ а также коэффициент натяжения зубчатого ремня, определяемый как 
отношение прогиба ремня к его длине и влияющий на жесткость, и демпфирование 
модуля линейного перемещения. 

При остановке электроприводов подвижные массы будут продолжать движение под 


действием инерционных сил, в результате чего точки А и Б займут положение А „Б 
соответственно, затем остановятся и под действием сил упругой деформации пружины и 
балки начнут совершать колебательное движения. 


Рассматриваемая модель имеет три степени свободы, обозначим независимые 


обобщенные координаты как Ч, Ф и В. Для описания данной модели воспользуемся 
уравнением Лагранжа второго рода: 


адт ОТ _ 
я ББ! 
04, 04, (= 1,2,..Ю, 


где Т- кинетическая энергия системы; О - обобщенная сила; К - количество степеней 
свободы. 

Кинетическая энергия системы с тремя степенями свободы является однородной 
квадратичной формой обобщенных скоростей [5]: 


Т= ХА +2А >44 + Аф ЗАЗ + Аз + А) (2.2) 


Й 


(2.1) 


Коэффициенты РЕГЕН функциями координат Ч, Ф и В. 
Предположим, что обобщенные координаты отсчитываются от положения равновесия, 


пе & =% =% =0 


Располагая коэффициенты АЦ а, Ф,Ф) по степеням и пологая для упрощения записи 


4,1000 =а 


К —8а,; получим: 


Т= (а. та + аф + 2а, 34,4% + азів Ы 2а,.& 4$) (23) 
Потенциальная энергия пі Ч, Ф, Ф) системы: 

1 
П = 16.4 +2С 4% + С.ф + 2С,ф@ + Св + 264%) канві 


п(0,00 «0 


При этом учитываем, что в положении равновесия обобщенные силы также 
обращаются в нуль. 
В (2.4) для упрощения приняты следующие обозначения: 

2 
дп дп дп дп = ао П с 
ты АХ РОТ 719392 2371682. — 33 
дф ‚ 049% . ОФ _ дода _ 0% 
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Для составления дифференциальных уравнений свободных колебаний в форме уравнений 
Лагранжа второго рода, выразим потенциальную энергию через обобщенные 


координаты. Рассмотрим равновесие системы, на которую действуют силы 1" 2,..., п. 
Потенциальная энергия в состоянии устойчивого равновесия имеет минимум, равный 


=: = С 


нулю, а при вызванном действием сил ` ! отклонении от него выражается квадратичной 
формой вида (2.4). 

Элементарная работа всех сил действующих на систему, по принципу возможных 
перемещений должна быть равна нулю: 


- дпа У Ебг =0 (2.5) 
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Замечая, что 
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а также приравнивая к нулю коэффициенты при независимых вариациях Ч, Ф и В, 
получаем три уравнения: 
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0% 28 Е. 
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Здесь 1, и я обобщенные силы для системы сил ус 
уравновешивающих потенциальные силы, возникающие при отклонении системы из 


положения равновесия (а —Ф —% -0 Заменяя в (2.6) производные потенциальной 
энергии их выражениями согласно (2.4), получим систему уравнений, определяющих 
значение координат Ч, Ф и Ч в положении равновесия: 

Спа + С.Ф + С = 

Сла + СФ + Оза -0 (2.7) 
Сла + С.Ф + Сз =0, 
причем С» = Са Сз С и аз =Су 
Решение системы (2.7) имеет вид: 
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Ф, зані заз + аз ©) (2.8) 
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где 
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а = СС - САС а = сс, ІЗ аз = пани - С.Оз (2.9) 
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ТОО ССС з+ ССС - СС СС Сб». 


На систему действуют обобщенные силы, которыми являются инерционные силы и силы 
сопротивления движению. Обычно в сложных системах в целях упрощения А, 51 силу 
сопротивления принимают пропорциональной первой степени скорости движения. С 


[94 
целью упрощения условимся, что угол З мал и координаты массы п можно записать 


сазан 
как Ч 4 ф ф. Позтому на оснований кинетостатики можем записать: 


© --(піуж Ва) (2.10) 


ж 
где 9 - обобщенная сила, В - коэффициент сопротивления пропорциональный первой 
степени скорости движения массы т. Так как масса собственно консоли манипулятора 
МРЛ-901П меньше массы закрепленных на ней рабочих головок, захватов и деталей, для 
упрощения примем условие, что точка исследования колебаний (практически - рабочий 
орган манипулятора) совпадает с точкой приложения сосредоточенной массы 11. 


Сила о действует на все звенья манипулятора следовательно: 
С =4 =4=4 ель 


Коэффициенты Ув (2.7) будем определять из того, что согласно (2.11) звенья можно 


о 


координате Ч, затем только по координате Ф и наконец только по координате в, тогда 
в выражение (2.7) можно переписать: 


С4+0-%+0:4=9 
бар Сф +0: = О (2.12) 
0:4 +0:ф+ С = О 

С» =С,; =(С,3 = (3, =Сз =С =0 


рассматривать независимо друг от друга. Положим сначала, что действует только по 


таким образом ‚ используя (2.9) находим: 


1 
бро = = 
11 12 13 
С; 
а РОТУ Ре (2.13) 
21 26 23 
22 
1 
©з = 32 =0 С зз с 
33 


Оуу 022 Ч зз 
Коэффициенты У и определяют податливость звеньев манипулятора по 


координатам а, Ф и Ф соответственно. Выражая податливость звеньев через их 
жесткость, запишем: 


1 1 1 
О =—— @55=— аа =— 
11 22 33 (2.14) 
С, С, С, 
где С С, и С; жесткости звеньев по координатам а, Ф и % соответственно. 


Подставляя (2.14), (2.11) и (2.10) в (2.8) получим: 


1 | 
2 + 
ат (11+ Ва) 
1 ( 
Ф =- —(пй+ Ва) (2.15) 
С 
1 ( 
Ф = 


[5] 


Для решения этои системы нужно выразить скорость и ускорение массы т через их 
составляющие: 
чені 
: А . А (2.16) 
а= + + 
Поскольку в манипуляторе суммарную жесткость удобно экспериментально определять, 
прикладывая соответствующее усилие к его рабочему органу, и так как в конечном итоге 
необходимо определить положение массы 1, координаты которой выражаются как 


с=т в, то для этого достаточно сложить уравнения в выражении (2.15) 
С; + С, + а ва 
абс; 


(2.17) 
или: 


Т 
а=- (10+ ва и 


где С- суммарная жесткость звеньев манипулятора 
Анализ показывает, 


что величина С является переменной и зависит от плеча 
приложения І сосредоточенной массы т 


Преобразуя (2.18), получаем уравнение описывающие переходный процесс в системе 
Сан 4+ 9=0 (2.19) 
Са 


Уравнение (2 19). легко решается классическим способом при следующих начальных 
условиях: 
Ф =0, $ =У (2.20) 


где 0 скорость рабочего органа манипулятора в момент выхода на конечную точку 


Выражение (2.19) представляет собой линейное дифференциальное уравнение второго 
порядка. Будем искать частное решение уравнения в виде 


Ф =Се“ + Се (2.21) 
С.Є 


где и 2 - за постоянные, которые могут быть определены из начальных 
условий: при і = 0; Ки А . корни характеристического уравнения: 
тов +10 (2.22) 
СС | 

Решение уравнения (2.22) будет иметь вид: 


в т 
СЕС, С 
К, = = (2.23) 
2-- 


С 


Определим произвольные постоянные "1 и 72, решая систему уравнений: 
и =С + © 
що =КС! +С, 
Решение системы (2.24) будет иметь вид: 
с -#0- 690) 
К - К (2.25) 
С; =у0)- С 


если учесть (2.20) то: 


и 
а= 


(2.24) 


Рт 
М 


г (2.26) 
с =- —% 
А - № 
подставляя (2.26) в (2.21) и с учетом (2.23) имеем: 
В, [В] ат в. [в] т 
чо | 2с, с в о 
у; 28 у 25 

49 = > ев“ (2.27) 

С |В ла й С В д 

ту С ту С Є 

2 
С С 
ов з 
где 2т. реальная часть; С - мнимая часть. 
Тогда разделяя реальную и мнимую части в (2.27) получим: 
іде, [9 
с! С, ле С, 
В т т 
У - 2— 2— 

Ф = ___ете с -е *° 228) 

С В д 

ту С Є 
Учитывая что: 
е" =соѕх+ 151шх, (2.29) 


имеем: 


у в С 
Ф = о @ 22 соз + ізіп = - 
На | | 2 22 22 
і С 
= 5 (2.30) 
| 41 ВР ді 
С С 
СО5 [+ 1510 ГА 
р р 
С 
Преобразуя (2.30) получим решение уравнения (2.19): 
р 
8-4 
ў в. С 
Ф = о Є 20 хіп Ї (2.31) 
2 ат 22 
ж С 


Прологарифмируем выражение (2.31) предварительно подставив в него значение 
допустимой погрешности позиционирования: 


В + (2.32) 


Пл = - Ш 


где "Р - допустимая погрешность позиционирования. 
Преобразуя (2.32) получим выражение для определения времени переходного процесса: 


а ат 
С 


т Я 
Э (2.33) 


пи - А, Ш 


іа = В 


2т 
Для расчета жесткости С и коэффициента демпфирования В в модели используются 
экспериментально полученные зависимости. В частности коэффициент демпфирования 
определяется по осциллограмме затухания колебаний рабочего органа. 


Таким образом, время переходного процесса, для данного типа манипулятора при 
заданной массе положении рабочего органа определяется по выражению (2.33), в 


котором коэффициенты жесткости и демпфирования предварительно определены 
экспериментально. 


2.2 Анализ переходных процессов в манипуляторе МРЛ-901П 

Источниками возникновения переходных процессов в манипуляторе МРЛ-901П 
являются: зубчатая ременная передача линейного модуля манипулятора и его свободная 
консоль. 

На зтапе зондирующих зкспериментов исследовались парнье зависимости козффициента 
демпфирования от натяжения зубчатого ремня и смещения рабочего органа вдоль 
консоли. Результаты анализа полученных осциллограмм сведены в таблицы 2.1 и 2.2. 
Анализ результатов показывает, что натяжение зубчатого ремня существенным образом 
влияет на коэффициенты демпфирования модуля линейного перемещения: так при 
увеличении начального натяжения ремня от минимального значения 7 = 0,03778 до 
максимального п = 0,00667 (в исследуемых приделах) коэффициент демпфирования 
уменьшается в 3 раза. Таким образом, можно сделать вывод о том, что демпфирование 
линейного модуля с зубчатой ременной передачей может задаваться и варъироваться в 
широких пределах, как на этапе конструирования, так и в процессе его эксплуатации. 
Табл. 2.1 

Результать анализа осциллограмм собственньх колебаний рабочего органа манипулятора 
МРЛ-901П на консоли 

Величина |Период Частота Логарифмический |Коэффициент Время 
смещения |колебаний |колебаний |декремент демпфирования |затухания 
рабочего  |рабочего ви, С-1 затухания у В, кг/с колебаний 
органа органа Т, с. іп.п., с. 
вдоль 
консоли /у, 
мм 


0 369 0,6 
175 227,55 0,9 


350 122,65 1,2 


Анализ результатов исследований показывает, что смещение рабочего органа 
манипулятора МРЛ-901П вдоль свободной консоли, также как и увеличение начального 
натяжения ремня, вызывает уменьшение коэффициентов демпфирования, что 
существенно (в 2...3 раза) увеличивает время полного затухания собственных колебаний 
рабочего органа (см. табл. 2.1 и 2.2), и, как следствие снижает реальную 
производительность. 

Смещение рабочего органа относительно основания и увеличение натяжения ремня 
приводит также к уменьшению частоты собственных колебаний манипулятора, что 
должно учитываться при использовании его в технологических процессах, связанных с 
резонансными явлениями. 

Комплексные исследования демпфирующих свойств манипулятора осуществлялись с 
целью установления численной зависимости коэффициента демпфирования от величины 
начального натяжения ремня и смещения рабочего органа вдоль консоли. В качестве 
функции отклика выбиралась линейная модель. База данных для построения плана 
экспериментов сведена в табл. 2. 

Основные уровни и интервалы варьирования выбирались на основе результатов 
зондирующих экспериментов, а также исследований жесткости и точносных параметров 
манипулятора МРЛ-901П. 


Табл. 2.3 


База данных для построения плана экспериментов 


Условное Область Основной Интервал 
Наименование фактора обозначение |определения |уровень варьирования 


Начальное натяжение 

ремня 7 Х, 0...0,04 0,02 0,013 
Величина смещения 

рабочего органаХ» 0...350 175 175 
манипулятора вдоль 


консоли Ју, мм 


Матрица планирования и результаты экспериментов сведены в табл. 2.4. 
Проводилась полная статистическая обработка результатов экспериментов, позволившая 


получить адекватную модель зависимости коэффициентов демпфирования от 
исследуемых факторов в виде: 


У «290Б-179БХ, - 138%, - 92Х.Х, (2.34) 


СА 


700 


А. аль ——— мыло. анн ль н Р а 


Рис. 2.2. Зависимость коэффициента демпфирования В манипулятора 
МРЛ-901П от начального натяжения ремня пи 


смещения і рабочего органа вдоль консоли. 


Поверхность отклика представлена на рис. 2.2. Выражение (2.34) позволяет получить 
численное значение коэффициента демпфирования, необходимое для расчета 
продолжительности переходного процесса при позиционировании. 


Табл. 2.4 
Матрица планирования и результатов зкспериментов по комплексному исследованию 
демпфирующих свойств манипулятора МРЛ-901П 


Среднее значение Дисперсия среднего Вычисленное 
Номер коэффициента арифметического значение 
опыта | ў я Ж 7 57 |демпфирования, 
ХХ |Х Х.Х, решо 

1 +1 |+1 |+1 |+1 240 64 240 

2 +1 |+1 |1 |1 700 49 700 

З +1 |1 |+1 14 65 4 65 

а +1 |-1 |1 |+1 157 16 157 


Экспериментальные исследования времени переходного процесса осуществлялись при 
помощи комплекта виброизмерительной аппаратуры АВ-44, вибродатчик которой 
крепился на рабочем органе манипулятора. 


2.3 Определение жесткости звеньев манипулятора МРЛ-901П 

Жесткость звеньев манипулятора МРЛ-901П определялась по экспериментальным 
замерам деформации консоли манипулятора при действии на нее определенного усилия. 
Таблица 2.5 


Деформация звеньев манипулятора МРЛ-901П под действием возмущающих сил 


Деформация звеньев манипуляционной системы д, мм 
Возму- Ось Х 
щающая 
сила ү-0 Е ая аА ОСЕБУ 

2 

0 0 0 0 0 
10 0,111 0,135 0,178 0,111 
20 0,206 0,234 0,390 0,206 
30 0,265 0,334 0,560 0,265 
40 0,302 0,418 0,750 0,302 
50 0,345 0,507 0,930 0,348 
60 0,390 0,580 1,090 0,393 
70 0,418 0,658 0,421 
80 0,460 0,745 0,465 
90 0,498 0,825 0,505 
100 0,534 0,902 0,540 


Результаты исследования жесткости приведены в таблице 2.5. По этим данным были 
построены график зависимости деформации от смещения рабочего органа (рис. 2.3) и 
график зависимости деформации от натяжения зубчатого ремня (рис.2.4). 


Рис. 2.3. Жесткость кинематической схемы робота МРЛ-90111. 
1 - деформация по оси Х при У «їх, 
2 - деформация по оси Х при У = У ах [2 


3 - деформация по оси Х при У =0(и по оси У, 


ЕН 


Рис. 2.4. Зависимость деформации д модуля ПР с 
зубчатой ременной передачей от возмущающего 


УСИЛИЯ В для различных значений начального 
натяжения ж зубчатого ремня. 


2.4 Исследование быстроходности манипулятора 

Быстроходность манипулятора характеризуется временем перемещения рабочего органа 
в требуемую точку. Теоретические предпосылки указывают, что непосредственное 
влияние на величину этого времени оказывают совместные механические 
характеристики (СМХ) электроприводов манипулятора. 

Исследование СМХ осуществлялось путем анализа тахограмм движения манипулятора 
МРЛ-901П, зарегистрированных самописцем НЗ38Д/1. Статистически обработанные 
результаты экспериментов сведены в таблицу 2.6 и представлены в графическом виде на 
рис. 2.5. 

Анализ экспирементальных данных показывает, что связь силы тяги, а, следовательно, и 


а; М 4 
допустимого ускорения 1 со значением достигнутой скорости 1 существенно 
нелинейна. Для определения квазиоптимальных режимов движения манипулятора 
необходимо связать параметры аи Уаналитическим выражением. 


Рот 


Представим каждое значение Б СМХ в виде разности Б =Р,,- А, где 


статическая тяговая синхронизирующая сила, а А - потери тяговой силы, зависящие от 
скорости движения манипулятора. 


Такая запись СМХ имеет то очевидное приемущество, что для каждого конкретного 
образца манипулятора указанной модели могут быть введены уточнения формулы путем 


измерения одного лишь значения | ст, 
Следовательно, определение эмпирической формулы СМХ сводится к отысканию 


А= КУ) 


зависимости . Воспользовавшись способом отыскания эмпирических формул, 


приведенным в [7], легко установить, что экспериментальные точки А наиболее точно 
отображают линейную  зависиюсть на  полулогарифмической  функцональной 


координатной сетке. Из этого следует, что выражение = КУ) может быть описано 
логарифмической функцией. Из 
Результаты исследований совместной механической характеристики манипулятора МРЛ- 


9011. 


Таблица 2.6 
Масса Число Численное значение синхронной скорости, м/с 
т паралельных среднее 
груза опытов среднее квадратическое принимаемое 
кг. арифметическое откланение значение 
2 10 0,80 0,013 0,8+0,04 
З 10 0,74 0,017 0,74+0,05 
4 10 0,67 0,016 0,67=0,05 
5 10 0,59 0,007 0,59=0,02 
6 10 0,49 0,013 0,49=0,04 
У 10 0,38 0,012 0,38=0,04 
8 10 0,29 0,010 0,29=0,03 
9 10 0,24 0,013 0,24+0,04 
10 10 0,20 0,011 0,20-0,03 
11 10 0,16 0,013 0,16-0,04 
12 10 0,12 0,006 0,12-0,02 
13 10 0,05 0,003 0,05=0,01 
линейной зависимости, представленной на рис. 2.6 легко отыскать коэффициенты ее 
уравнения, вид которого НЕ Б В итоге имеем: 
А=1133 19100 (2.35) 


где: У измеряется В м/с Я 


Следует, однако, заметить, что при нарастании значения экспериментальные точки А 
несколько удаляются от прямой, описанной уравнением (2.35). Поэтому, с целью 
уточнения зависимости была внесена поправка, с учетом которой эмпирическая формула 
СМХ примет вид: 


Е, ЗЕ, - 11333.19100/- 10/ (2.36) 
е 


где: У - измеряется в м/с за " Сс2-в|НІ, или 


а Ент 1133319100 - 10/ зда 
т 


а У 
где: 1, 1 - допустимые мгновенные значения ускорения и скорости соответственно (при 


этом лежит в интервале от 0,1 м/с до 0,8 м/с, 


0 10. 20 30 40 | 50 


Рис. 2.5. Совместная механическая характеристика манипулятора МРЛ-901П: 


М - кривая, описываемая эмпирической зависимостью. 


$ — среденее измереннное Значение с его доверительным интервалом, 


о 0 200 300 400500600 800 У ММ. 


Рис.2.6 График потерь тяговой силы манипулятора МРЛ-901П 


2.5 Методика проведения эксперимента по определению механических характеристик 
манипулятора МРЛ-901П 

Для исследования СМХ манипулятора портального типа МРЛ-901П наиболее удобной 
является следующая методика измерений. 


Рис.2.7 Стенд для исследования механической 
характеристики манипулятора МРЛ-901П 


На свободный конец вала электродвигателя ШД 5Д1МУЗ крепился тахогенератор, 
электрический выход которого связан с измерительной схемой (рис. 2.7) вольтметра. 
Схема тарировалась путем задания устройством управления 2Р22 постоянных значений 
скорости движения рабочего органа манипулятора. При этом электродвигатель был 
полностью разгружен от момента нагрузки. 

После тарировки к рабочему органу манипулятора прикреплялась перекинутая через 
ролик гибкая стальная нить, на свободный конец которой подвешивался переменный груз 


що По команде системы управления электродвигатель начинал равноускоренно 
вращаться, перемещая при этом рабочий орган манипулятора и преодолевая 


Р і .. У 
противодеиствие груза щу Дойдя до определенного значения скорости ! двигатель 
выходил из синхронизма, что отмечалось на фиксируемой самописцем тахограмме 
резким падением уровня сигнала. 


[1 


Изменение массы груза приводило к выходу электродвигателя из синхронизма уже 


З у. М 
при другом значении достигнутой скорости 11. Таким образом, были найдены 
соотношения веса противодействующего груза и критической синхронной скорости ШД 
во всем диапазоне его работы. 


а<< 
Для уменьшения влияния инерционности системы задавалось 9, что позволило с 
точностью 5 - 7% полагать, что вся сила т в момент выхода ШД из синхронизма 


расходуется на удержание груза щу „ще: Би 9 : 
СМХ манипулятора определялась последовательно, для каждой программируемой 
координаты. 


Для исследования других динамических характеристик, определяющих 
производительность манипулятора, необходимо вернуться к рассмотренному выше 
переходному процессу при позиционировании манипулятора. 
В уравнение движения манипулятора (см. раздел 2.1) в качестве постоянных величин 
входят коэффициенты, пропорциональные скорости перемещения рабочего органа - 
коэффициенты демпфирования. 
Коэффициент демпфирования В может быть определен по осциллограмме затухания 
колебаний рабочего органа манипулятора с использованием расчетной формулы: 

00 (2.38) 

Г. 

где т - масса подвижной части манипулятора; 
у - логарифмический декремент затухания колебательного движения; 
Т - период колебаний. 


2.6 Сравнение результатов расчета модели с экспериментальными данными 

Результаты исследования жесткости и демпфирующих свойств манипулятора 
использовались для расчета времени переходного процесса при позиционировании. 
Расчет производился из аналитических выражений, полученных в разделе 2. 1 
настоящей работы; его результаты сравнивались с экспериментальными данными (рис. 
2.8). 

Из графика видно, что расчетная кривая лежит в области экспериментально измеренных 
значений, это свидетельствует о достаточной точности модели, что позволяет 
использовать ее на практике. 
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Рис. 2.8. Время переходного процесса в роботе МРЛ-901П до требуемой точности позиционирования при і я 


0,35 м # = 0,02, / - расчетное значение, 
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# “\у — среднее измеренное значение с доверительным интервалом 
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3. Оптимизация скорости перемещения рабочего органа манипулятора 
3.1 Время перемещения рабочего органа манипулятора 


Ув 


8 52 5% 


Рис 3.1. График изменения скорости движения рабочего органа манипулятора при 
перемещении между двумя рабочими точками. 


Траектория движения рабочего органа манипулятора состоит из участков разгона и 
торможения, а также участка, где перемещение происходит с постоянной скоростью. 
Очевидно, что минимальное время перемещения будет достигнуто при максимально 
возможных значениях скорости и ускорения, определяемых из совместной механической 
характеристики манипулятора (см. раздел 2.4). Заметим также, что время перемещения 


и 
зависит от скорости в момент выхода на конечную точку 0 (см. рис. 3.1). При 
увеличении этой скорости, протяженность участка 5, уменьшается, а протяженность 


участка 5, увеличивается, тем самым возрастает средняя скорость движения рабочего 
органа, но при этом увеличивается время переходного процесса в момент останова. 
Таким образом для достижения минимального времени перемещения с учетом 
переходного процесса необходимо определить оптимальное значение скорости выхода на 


конечн % 

ую точку 0. 

Время перемещения зависит от максимальных значений скорости и ускорения рабочего 
органа, а также от скорости в момент выхода на конечную точку рабочего органа 
манипулятора и складывается из следующих значений: 


= +++ (3.1) 
где Г _ время перемещения рабочего органа; й, 5, Б. время перемещения рабочего 


органа на первом, втором и третьем участке траектории соответственно (см. рис 3.1); ба 
- время переходного процесса. 

Время перемещения на первом участке траектории определяется из значений 
максимальной скорости и ускорения: 


ГА = У пах 


аах 


2 


(3.2) 


У а а 
где х - максимальная скорость перемещения рабочего органа манипулятора; ах - 


максимальное ускорение рабочего органа манипулятора. 
На втором участке траектории рабочий орган перемещается равномерно с максимальной 
скоростью, при этом время перемещения составит: 


‚ _5- (8+8) 


(3.3) 
У нах р 
=© + $ + 
где 5 - расстояние между двумя конечными точками: 5 5 5, 5, 
Время перемещения на третьем участке траектории: 
== Уы" и 
= (3.4) 
аах 


У 
где 0 - скорость рабочего органа манипулятора в момент выхода на конечную точку. 
У 
Длина первого участка определяется скоростью ах, которая достигается в конце этого 


участка, ускорением д пах, и выражается как: 


и 


— тах 
5 = (3.6) 
аах. 
Е У 
Длина третьего участка определяется начальной скоростью этого участка - шах, 


а Э и 
ускорением "захи конечной скоростью 0: 


вые 


РЕ (3.8) 

аах 

Для определения времени перемещения на втором участке подставим (3.6) и (3.8) в (3.3): 
5 и № 

А р - тах | 0 (3.9) 


Мах аах 2Уахдлах . 


Общее время перемещения с учетом переходного процесса получим подставляя (3.2), 
(3.4), (3.9) и (2.33) в (3.1): 


Ко ых 
С 
рл, + Ш 
2т (3.10) 
5 и У | Мах, ДПУ, 
ЛЕО + ——— - ——— + тая нн 
Мах 20,8 лах д пах дах В В 
2т 


Анализируя выражение (3.10) относительно скорости выхода на конечную точку \, 
получаем график времени перемещения рабочего органа манипулятора с учетом 
переходного процесса (см. рис.3.2). Из графика видно, что переходный процесс 
значительно влияет на время перемещения рабочего органа манипулятора. 
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Рис. 3.2. Время перемещения рабочего органа с учетом переходного процесса в зависимости от скорости в момент 
выхода на конечную точку при, в = 20см 


3.2 Время перемещения рабочего органа манипулятора при малых расстояниях между 
рабочими точками 


Рис 3.3. График изменения скорости движения рабочего 
органа манипулятора при перемещении между двумя 
рабочими точками, в случае, когда рабочий орган не 
успевает набрать максимальную скорость. 


Часто возникают случаи, когда расстояние между двумя рабочими точками мало и 
рабочий орган манипулятора не успевает набрать максимально возможную скорость. 
При этом траектория движения состоит только из двух участков - разгона и торможения 
(см. рис. 3.3.). Скорость рабочего органа на участке разгона достигает некоторого 


У 
значения 4, длина этого участка составит: 


и 


— Д 


(3.11) 
2 ах, 


где 4 - максимальная скорость которую успеваєт набрать рабочий орган манипулятора; 


дах - максимальное ускорение рабочего органа манипулятора. 
На втором участке траектории необходимо производить торможение рабочего органа в 


о и 
связи с тем что по достижению конечнои точки его скорость должна иметь значение 0 
при этом длина второго участка составит: 


2 - № 
5, о (819) 


тогда складывая выражения (3.11) и (3.12) получим суммарное перемещение рабочего 
органа: 


25? - 
520-0 (3.13) 
2а 


тах 


7 


Зная расстояние между двумя рабочими точками, из (3.13) получим выражение для 
определения максимально достигнутой скорости: 


1 
81 


(3.14) 
Используя (3.14) определим время перемещения рабочего органа на первом: 
У 
нам (3.15) 
опа 
и втором участке: 
У и 
Ё =— (3.16) 
дах 


Суммируя выражения (3.15), (3.16) и (2.33) получим выражение для определения 


времени перемещения с учетом переходного процесса при условии, что рабочий орган не 
успевает набрать максимальную скорость: 


ВЕ 
С 
1 ПА, + Ш ча зо 
ій 455+ 5 0 Е и 2пу, 2 
аа В 05 
2т 


и 
Анализируя выражение (3.17) относительно скорости выхода на конечную точку 0, 
получаем график времени перемещения рабочего органа манипулятора с учетом 
переходного процесса (см. рис.3.4) для малых перемещений рабочего органа. 


0 0.02 0.04 0.06 0.08 0,10 0,12 0,14 0,16 0.18 мс 
Рис. 3.4. Время перемещения рабочего органа с учетом переходного процесса в зависимости от скорости в 
момент выхода на конечную точку, при 5 = 1см. 


3.3 Получение оптимальной скорости в момент выхода на конечную точку 
Анализ выражений (3.10) и (3.17) показывает (см. рис. 3.2, 3.4), что время перемещения 


и З 
рабочего органа будет минимально при таком значении скорости 0, когда переходныи 
процесс в системе отсутствуют, то есть максимальная амплитуда колебаний не 


превышает допустимой погрешности позиционирования  "?. Для определения скорости 


и 
‚ достаточно прировнять к нулю выражение (2.33): 
2 


А 
С 


ІА, + № 
дн (3.18) 
С 


2 
Решение (3.18) относительно и имеет вид: 


с в 
® Ар, Е - 4— (3.19) 


Выражение (3.19) определяет такое значение скорости в момент выхода на конечную 
точку при которой амплитуда переходного процесса не превышает предельно 
допустимого значения, а следовательно время перемещения рабочего органа 
определяемое выражениями (3.10) и (3.17) минимально. 

Анализ графиков зависимости времени перемещения с учетом переходного процесса от 
скорости выхода на конечную точку (см. рис. 3.2, 3.4.) показывает, что скорость выхода 
значительно влияет на время перемещения рабочего органа и отклонение скорости в 
большую сторону от расчетного значения ведет к значительным потерям времени за счет 
увеличения длительности переходного процесса. 

Если проанализировать выражения (3.10) и (3.17) относительно допустимой погрешности 


позиционирования ТР, то можно сделать вывод, что при увеличении допустимой 
погрешности позиционирования (см. рис. 3.5, 3.6.) наблюдается уменьшение времени 
перемещения, что можно использовать на операциях с низким требованием к точности, 
хотя это уменьшение весьма не значительное. 
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Рис 3.5. Время перемещения рабочего органа с учетом переходного процесса в зависимости от точности 
позиционирования, при в = 20 см. 
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Рис 3.6. Время перемещения рабочего органа с учетом переходного процесса в зависимости от точности 
позиционирования, при в = 1см. 


4. Программные средства для исследования динамической модели портального 
манипулятора 

4.1 Программа для вычисления параметров переходного процесса портального 
манипулятора 

Для исследования полученной динамической модели, построения графиков приведенных 
в работе, использовалась программа “Модель портального манипулятора МРЛ-901П в 
момент позиционирования” (см. рис. 4.1). Программа разработана для среды М/ТМ32 АРІ 
на языке С++ с использованием компилятора ВоЙапа С++ 5.02 и может выполняться на 
операционных системах Міпаӣомѕ 95/98 и МЯпаомз МТ. 

Вычисление параметров переходного процесса в программе осуществляется с 
использованием выражения (2.31) при помощи которого вычисляется амплитуда 
колебаний рабочего органа манипулятора. По полученным значениям строится график 
переходного процесса и график зависимости времени переходного процесса от точности 
позиционирования. 


модель портального макипулятора МРЛ- 2010 = нонект позиционирования 


модель портального манниулят: 


Ввод исходных данных осуществляется при помощи диалогового окна “Исходные данные” 
при выборе пункта меню “Расчет/Переходный процесс” (см. рис. 4.2). В диалоговое окно 
(см. рис. 4.3) вводятся необходимые исходные данные. После ввода исходных 
данных программа вычисляет амплитуду и длительность переходного процесса и выводит 
результаты расчетов в виде графиков. 
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Рис. 4.3 Диалоговое окно для ввода исходных данных. 


4.2 Программа для вычисления времени переходного процесса и оптимальной скорости 
Для практического использования динамической модели при разработке 
технологических процессов, вычисления главных параметров - времени переходного 
процесса и оптимальной скорости позиционирования, используются выражения (2.33) и 
(3.19), которые были использованы при создании программы “М!” (см. рис. 4.4). 


Расчет времени переходного процесса м оптимальной скорости позыционирования 
Разработал Д.В. Грачев 1999 Е-Ма11 депі582та11 .замаїом ги 


Исходные данные для расчетов : 


Скорость позиционировання рабочего органа, мм/с - 150 

Требуемая точность позиционирования рабочего органа, мм - 0.1 

Коэффициент демпфирования кинематической схемы манипулятора, кг/с - 139.59 
Жесткость кинематической схемы манипулятора, Н/м - 97561 

Масса подвижной части манипулятора, кг - 11 


Результаты расчетов: 
Длительность переходного процесса при заданной скорости 0.15 м/с 


составит - 0.435581 с. 
Оптимальная скорость позиционирования - 9.39614 ммс 


Рис. 4.4 Вычисление времени переходного процесса и оптимальной скорости 
позиционирования. 


Программа “М!” использует текстовую консоль для ввода и вывода данных. Исходные 
данные и результаты вычислений записываются в файл. При необходимости, для задания 
имени файла результатов вычислений, можно использовать параметры командной 
строки. 

Программа написана на языке С++ с использованием стандартных функций и может 
быть откомпилирована для работы в операционных системах 005, МІМ32 и ОМІХ. Текст 
программы приведен в приложении к данной работе. 


Заключение 

В ходе выполнения дипломной работы была построена динамическая модель портального 
манипулятора, параметры которой хорошо соответствуют параметрам реального 
манипулятора. При исследовании модели особое внимание уделялось получению 
выражений для определения оптимальных значений скорости движения рабочего органа 
с целью увеличения быстродействия манипулятора. Также в ходе исследования 
определены численные значения коэффициентов, входящих в динамическую модель 
манипулятора при его позиционировании. Установлено хорошее соответствие (ошибка в 
пределах 1...2%) расчетного значения продолжительности переходного процесса при 
позиционировании и реального позиционирования манипулятора. Разработаны методы 
влияния на вид и продолжительность переходного процесса путем управляемого 
регулирования технологических факторов: натяжения зубчатого ремня и взаимного 
расположения подвижных частей манипулятора МРЛ-901П. Исследованы диапазоны 
варьирования, определены значения технологических факторов, обеспечивающие 
максимальную производительность роботизированного оборудования, создаваемого на 
базе робота МРЛ 9011. 

Проведенные исследования могут быть использованы для определения рациональных 
динамических параметров манипуляторов, разработки технологических процессов, а 
также в учебном процессе при проведении лабораторных работ. 


ПРИЛОЖЕНИЕ 


В приложении приведены программы для расчета параметров динамической модели 
портального манипулятора. 


// Ейе Мгі.срр 
/ Программа для расчета времени переходного процесса и оптимальной 
// скорости позиционирования 


ііпсіиде <ѕіаіо.һ> 

ііпсіиде <ѕїаір.һ> 
#тшсаае «сопіо р» 
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ілі Тгапзеп (Чон е&, 
доийріе, 
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доийріе ); 


іпї ОрИита!5 рее (дон Ые&, 
доийріе, 
доийріе, 
доче, 
доийріе ); 


сраг * $ е = "п Расчет времени переходного процесса и оптимальной " 
"скорости позиционирования\п Разработал Д.В. Грачев 1999" 

" Е-Маі депіѕФ@таі.ѕагаіоу.ги"; 

сраг * $ У0 = "\п\п Исходные данные для расчетов:\п\п Скорость" 

" позиционирования рабочего органа, мм/с - # "; 


срагх $ а = " Требуемая точность позиционирования рабочего органа, мм - Я "; 
сһаг * $ р = " Коэффициент демпфирования кинематической" 

" схемы манипулятора, кг/с - Я "; 

сһаг * $ с = " Жесткость кинематической схемы манипулятора, Н/м - Я "; 

сраг * $ т = " Масса подвижной части манипулятора, кг - Я "; 


сраг * $ шр = "%Ш"; 

сћһаг * $ оці = "%0\п"; 

сћаг * $ оцір = "п Результаты расчетов: \п\п Длительность переходного" 
" процесса при заданной скорости %9 м/с\п составит - %4 с." 

"р Оптимальная скорость позиционирования - %9 мм/с\п"; 

сраг * Е = "гезийаї хі"; 

сраг * $ радрагат = "п Недопустимый параметр - %с"; 


уоіа іпррагат(сһаг** р) 

{ 

верите" 

ргіпії (5 радрагата, *р[1]); 
ехії(0); 

) 


зігсру(Т, р[21); 
+ 


ілі таіп(іпі а5, сһаг** ау) 


{ 
очЫе +, у0, ору0, Б, с, а, т; 


ргіпі (5 Не); 
ії (аз > 1) іпррагата(ам); 


жоїг5іг(5 у0,"#") = 0; 
жоігвіїт(є д,'Я") 
жігѕіг(ѕ рБ,"яЯ") 
жоїг5їг(5 с,"#") 
жоїг5іг(5 т,"#") ; 


0; 
0; 
0; 


ргіпії ($ у0); 
зсапі ($ іпр, &у0); 
у0 /= 1000; 

ргіпії ($ а); 

зсапі ($ іпр, &9); 
а /= 1000; 


ргіпії (5 5); 
зсапі ($ іпр, &); 


ргіпії ($ с); 
зсапі ($ іпр, &с); 


ргіпії ($ т); 
зсапі ($ іпр, бат); 


Тгапѕіепі(ї, у0, а, Б, с, т); 
Оріта1Ѕреед(оруо, а, Б, с, пп); 


ору0 *= 1000; 
риши ($ ошір, У0, +, ору0); 


ҒПЕ * Ғ гез = Юореп(їп, "а+"); 


У0 *= 1000; 
Гргіпії (Ї ге5,5ітсаї(5 У0,5 ош), У0); 


а *= 1000; 
Гргіпії (Ї геѕ,ѕїгсаї(ѕ д,5 оці), а); 


Гргіпії (Е геѕ,ѕігсаї(ѕ 0,5 оці), Б); 
Гргіпії (Е геѕ,ѕігсаї(ѕ с,5 опі), с); 
Гргіпії (Ї ге5,5ігсаї(5 га,5 оці), т); 
Гргіпії (Е геѕ,5 ор, уб, ї, ору0); 


геїитп 0; 


| 


// ЕЧе ѕрееа.срр 
// Вычисление оптимального значения скорости в момент позиционирования 
// по исходным данным 


#шсшае <таіһћ.һ> 


іпі ОрИта!5 рее (донЫе& УО, // Начальная скорость 

очЫе реа, // Требуемое значение точности позиционирования 
опЫе рейа, // Коэффициент демпфирования 
ЧопЫе С, // Жесткость 
доче т) // Масса 

1 

очЫе тс2 = 2*1/С; 

УО = реа * (1/пас2) * заг Ғарѕ( ром(реіа/С,2 

)-2* пас2)); 


геїитп 0; 


} 
// ЕПе їгапѕіері.срр 


// Вычисление времени перходного процесса 
// по исходным данным 


#шсшае <та 1.65 > 


іпі Тгап5іепі(допріеб: ї,// Время переходного процесса 
опЫе У0, // Начальная скорость 
очЫе реа, // Требуемое значение точности позиционирования 
опЫе рейка, // Коэффициент демпфирования 
ЧопЫе С, // Жесткость 
доче т) // Масса 
1 
очЫе тс2 = 2*1/С; 
Е = (109(У0)-Іод(РеІға)-Іод(ѕагі( Ғарѕ(ром(реїѓа/С,2)-2%*т1с2 
) 


)/1с2 ) 
)*2*т/БеКа; 
геїитп 0; 


) 


